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Abstract — Four types of attitude control systems are devel- 
oped for the rotational dynamics of a rigid body on the special 
orthogonal group. First, a smooth control system is constructed 
to track a given desired attitude trajectory, while guaranteeing 
almost semi-global exponential stability. It is extended to 
achieve global exponential stability by using a hybrid control 
scheme based on multiple configuration error functions. They 
are further extended to obtain robustness with respect to a 
fixed disturbance using an integral term. The resulting robust 
global exponential stability for attitude tracking problems on 
the special orthogonal group is the unique contribution of this 
paper. These are illustrated by numerical examples. 

I. Introduction 

The attitude dynamics of a rigid body have been exten- 
sively studied under various assumptions [1], [2]. One of the 
distinct features of the attitude dynamics is that it evolves on 
a nonlinear manifold, namely the three-dimensional special 
orthogonal group. The nonlinear structures of configuration 
manifolds yield unique properties that cannot be observed 
from dynamic systems on a linear space. For example, it has 
been shown that there exists no continuous control system 
that asymptotically stabilizes an attitude globally [3]. 

Recent studies on attitude control systems can be summa- 
rized into two approaches, namely smooth attitude controls 
for almost global asymptotic stability [4], [5], and hybrid 
attitude controls for global asymptotic stability [6], [7]. In 
the former approaches, the region of attraction only excludes 
a domain whose measure is zero. This can be considered as 
the strongest stability property for smooth control systems, 
given the topological restriction on attitude controls [3]. The 
latter approaches formulate hybrid attitude control systems 
with a hysteresis-based switching algorithm to achieve global 
asymptotic stability, while avoiding chattering. But these 
results are based on either LaSalle's principle or hybrid 
invariance principles, and therefore, they cannot be uniformly 
applied to attitude tracking problems or they only guarantee 
asymptotic stability. Furthermore, robustness with respect to 
uncertainties has not been well addressed. 

Attitude control systems can also be categorized with the 
choice of attitude representation. It is well known that mini- 
mal attitude representations, such as Euler angles, suffer from 
singularities [8]. Quaternions do not have singularities but, as 
the three-sphere double-covers the special orthogonal group, 
one attitude may be represented by two antipodal points. 
This ambiguity should be carefully resolved in quaternion- 
based attitude control systems, otherwise they may exhibit 
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unwinding, where a rigid body unnecessarily rotates through 
a large angle even if the initial attitude error is small [3]. To 
avoid these, an additional mechanism to lift measurements 
of attitude onto the unit-quaternion space is introduced [6]. 

In this paper, we develop four types of attitude control 
systems to track a given desired attitude trajectory. A smooth 
attitude control system is developed for almost semi-global 
exponential stability, and a hybrid control system with a new 
form of direction-based configuration error functions is intro- 
duced for global exponential stability with simpler controller 
structures. They are extended with a unique integral control 
term to achieve robust global exponential stability. 

The proposed attitude control systems have the following 
distinct features. First, they provide stronger exponential 
stability. The attitude control systems in the aforementioned 
papers rely on the invariance principle, or an exogenous 
system is introduced to reformulate a tracking problem into 
stabilization of an autonomous system [6], [7]. As a result, 
they are applied only to attitude stabilization, or they cannot 
yield stability properties stronger than asymptotic stability. 
In the stability analysis of the proposed control systems, the 
time-derivative of a Lyapunov function is negative definite, 
and therefore they are uniformly applied to time-varying 
systems of attitude tracking problems, while guaranteeing 
exponential stability. 

Second, a new intuitive form of attitude configuration 
error functions is introduced to simplify the design of hybrid 
attitude control systems. Configuration error functions in the 
prior literature, such as [7] are based on compositions with 
smooth operations representing stretched rotations, and it is 
not straightforward to obtain proper controller parameters 
such as a hysteresis gap for stability. The proposed family 
of configuration error functions is constructed by comparing 
the desired directions with the current directions, and they 
yield an explicit condition on controller parameters for global 
exponential stability. 

Third, a special form of integral term is proposed in the 
control input for robustness with respect to disturbances. 
Nonlinear PID-like attitude control systems have been stud- 
ied in [9], [10], [11], [12]. But, either they have singulari- 
ties [9], [10], or they are based on the invariance principle 
that is valid only for attitude stabilization [11], [12]. The 
robust attitude control systems presented in this paper yield 
global exponential stability for attitude tracking. 

Another distinct feature is that attitude control systems 
are developed on the special orthogonal group. Therefore, 
singularities or complexities associated with minimal rep- 
resentations are avoided. Also, the ambiguity of quaternions 
does not have to be addressed by an additional mechanism to 



avoid the unwinding. In short, the proposed attitude control 
systems have simpler controller structures, but they provide 
stronger stability properties as well as robustness. 

II. Problem Formulation 

A. Attitude Dynamics on SO (3) 

Consider the attitude dynamics of a rigid body. Define 
an inertial reference frame and a body-fixed frame. Its 
configuration manifold is the special orthogonal group: 

S0(3) = {R £ R 3x3 | R T R = I, det[R] = 1}, 

where a rotation matrix R £ S0(3) represents the transfor- 
mation of a vector from the body-fixed frame to the inertial 
reference frame. The equations of motion are given by 



jn 



£1 x Jfl = u 
R = RQ, 



A, 



(1) 
(2) 



where J g 



Sx3 



is the inertia matrix, and f2 £ 



the angular velocity represented with respect to the body- 
fixed frame. The control moment and the unknown, but fixed 
uncertainty are denoted by u € R 3 and AeM 3 , respectively. 

At the hat map A : R 3 — > so (3) represents the 
transformation of a vector in R 3 to a 3 x 3 skew-symmetric 
matrix such that xy = x x y for any x,y € R 3 [13]. 
The inverse of the hat map is denoted by the vee map 
V : so (3) — > R 3 . Throughout this paper, the dot product 
of two vectors is denoted by x ■ y = x T y for any x, y £ R™, 
and the maximum eigenvalue and the minimum eigen value 
of J are denoted by Am and A m , respectively. 

Several properties of the hat map are summarized as 



xyz = {x ■ z)y 



(x ■ y)z, 

T 



x ■ yz — y ■ zx, 

x x y = xy — yx = yx~ — xy 

b{Ax] = ^ti[x(A - A T )} = ~x T (A - A T Y 

xA + A T x = (MA]I 3x3 -A}x^, 
RxR T = (Rx) A , R(x xy) = Rx x Ry 



(3) 
(4) 

(5) 
(6) 
(7) 



for any x, y, z £ R 3 , A € R 3x3 and R £ S0(3). 

The two-sphere is the manifold of unit-vectors in R 3 , i.e., 
S 2 = {g£l 3 | \\q\\ = 1}. Let 6i,6 2 € S 2 be the unit- 
vectors from the mass center of the rigid body toward two 
distinct, characteristic points on the rigid body, represented 
with respect to the body-fixed frame. They may represent 
the direction of the optical axis for an onboard vision-based 
sensor, or the direction of solar panel of a spacecraft. Due 
to the rigid body assumption, the unit-vectors are fixed, i.e., 
bi = b 2 = 0. Without loss of generality, we assume that 61 
is normal to 6 2 , i.e., b\ ■ b 2 — 0. If b\ ■ b 2 ^ 0, we choose a 
fictitious direction 63 as 63 = p^^ji > an d rename it as b 2 . 

Let ri(t),r 2 (t) £ S 2 be the representations of 61,62 with 
respect to the inertial frame. We have 

n(f) = R(t)h, ra(t) = R{t)b 2 . (8) 
Using |7]i and Q, the kinematic equations for r\ , r 2 are 

fi = RObi = (RQ) A Rbi = wxr„ (9) 



for i £ {1, 2}, where us = i?f2 £ R 3 is the angular velocity 
of the rigid body, represented with respect to the inertial 
frame. The attitude kinematic equation Q can be rewritten 
as R = uiR from 1(7}. 

B. Attitude Tracking Problem 

Suppose that a smooth desired attitude trajectory is given 
by Rd(t), and it satisfies the following kinematic equation: 



R d (t)=u d (t)R d (t), 



(10) 



where uj d £ R 3 is the desired angular velocity expressed in 
the inertial frame, which is assumed to be bounded. 

While it is possible to develop a control system directly 
in terms of R d , we transform the desired attitude into the 
desired directions for r\ and r 2 as follows: 



r dl = R d bi, r d2 = R d b 2 



(11) 



This formulation is to construct a new form of configuration 
error functions for hybrid control systems developed later. In 
some applications, such as antenna pointing of satellites, the 



desired attitude trajectories are directly described by ( 1 1 



From (10 1 and (Hi, the desired directions satisfy the 



following kinematic equation: 



r dl =uj d x r dl , r d2 = uj d x r d2 



(12) 



and they are consistent with the rigid body assumption, 
i.e., 61-62 = ri ■ r 2 — r\ d ■ r 2d = 0. The goal is to 
design the control input u such that the attitude R(t) (or the 
characteristic directions r\ (t) , r 2 (t)) asymptotically tracks 
the desired value R d (t) (or ri d (t),r 2d (t)). 

III. Global Attitude Tracking with No 
Disturbance 

In this section, we consider a case where there is no 
disturbance, i.e., A = 0. A smooth control system is first 
developed for almost semi-global exponentially stability, and 
a hybrid control system with new set of configuration error 
functions are proposed for global attitude tracking. 

A. Almost Global Attitude Tracking 

Error variables are defined to represent the difference 
between the desired directions ri d ,r 2d and the current di- 
rections r\ = Rbi,r 2 = Rb 2 . Define the i-th configuration 
error function as 

1, 



y i (Rb l 



Rbi 



l-Rbi-r di , (13) 



which represents 1— cos 9i, where 8i is the angle between Rbi 
and r di for i £ {1, 2}. Therefore, it is positive definite about 
Rbi — r di , and the critical points are given by Rbi = ±r di . 
The derivative of "I^ with respect to R along the direction 
of 5R — Ri) for rj £ R 3 is given by 

* 4 (i?exp(e77 i )6. i ) = -Rfjbi ■ r d . = r) ■ (R T r eh x b,). 

e=0 



de 



From this, the configuration error vector is defined as 

e Ti = R T r dz x bi, 



(14) 



for i G {1, 2}. For positive constants ki 7^ fc 2 , we also define 
the complete configuration error function and error vector as 

9{R) = fc 1 * 1 (i?6 1 ) + fc 2 * 2 (i?6 2 ), (15) 
e r = kie ri + k 2 e T2 . (16) 

The angular velocity error vector is defined as 



en = Q - R uj d . 



(17) 



Proposition 1: The error variables ( 13 i-( 17 1, representing 
the difference between the solution of the equations of 



motion 



IJ and Q, and the given desired trajectory ( [TT] ) 



with (12 1, satisfy the following properties, for i 6 {1,2}: 

(i) ^i(Rbi) = e n ■ e n , and = e r ■ e n . 

(ii) PrJ < ||en||, and ||e r || < (ki + fc 2 )||en||. 

(iii) If ^ < ip < hi, then \ff is quadratic with respect to 
||e r ||, i.e., the following inequality is satisfied: 

hi 9 hih<± 



< < 



(18) 



h 2 + h 3 h 5 (hi-tp) 

where constants hi, h 2 , h 3 , /14, ft. 5 G R are defined as 
hi — 2min{A; 2 , fci}, h 2 = 4max{(fci — fc 2 ) 2 , fc|, fc 2 }, 
h 3 = 4max{(fcx + k 2 ) 2 ,k^,kf}, h 4 = 2(ki + k 2 ), 
h 5 = 4min{(fc 1 + k 2 ) 2 ,k 2 ,k 2 }. 
Proof: See Appendix [A] ■ 
Using these properties, we develop a control system to 
follow the given desired trajectory as follows. 

Proposition 2: Consider the dynamic system Q with 
A = 0. A desired trajectory is given by ( 12 1. For fci, k 2 , fc w > 
with ki ^ k 2 a control input is chosen as 

u = -e r - knen + (R T Lu d ) A JR T oj d + JR T tu d . (19) 

Then, the following properties hold: 

(i) There are four equilibrium configurations for 
(R,uj), given by {(R dl uj d ), (exp(nf dl )R d ,uj d ), 
(exp(Trr d2 )R d ,uj d ), (exp(ir(r dl x r d2 ) A )R d ,w d )}. 

(ii) The desired equilibrium (R d ,u d ) is almost globally 
asymptotically stable and almost semi-globally expo- 
nentially stable, where an estimate to the region of the 
initial conditions for exponential stability is given by 

*(-R(0)) < ip < 2min{/c 2 ,fci}, (20) 

IMO)|| 2 <^0A-*(i?(o))). (21) 

(iii) The three undesired equilibria are unstable. 

Proof: Using (17i, (19i, and rearranging with ([SJ, the 
time-derivative of Jen can be written as 



Jen = {Je n + (2 J - tr[J] I)R T u Jd } A en 



knen- 
(22) 



The equilibrium configurations correspond to the critical 
points of the configuration error functions where r\ = ±r dl 
or r 2 — ±r d2 , and u = oj d . For example, when r\ = r dl 
and r 2 = r dr> , we have R = R d . When n = —r dl an d r 2 = 
r d2 , the attitude is the 180° rotation of the desired attitude 
about r d . 2 , yielding R = exp(irr d2 )R d . Other equilibria are 
obtained similarly, and these show (i). 



Let a Lyapunov function be 
1 



V 



-en • Jen + * + cJen ■ e r 



for a constant c. Using (18 1, we can show that 

z T Miz < V, 



(23) 



where z 



e J2 



Mi = 



1 



'12 +'13 
-cAm 



and Mi G 
-cAm 

A m 



(>2x2 j s gj yen by 
(24) 



From ( 22 1 and the property (i) of Proposition [T[ 

V = -fcn||en|| 2 + cJen ■ e r + cJen • e r . 

We find the bound of the last two terms of the above 
equation. Using the property (ii) of Proposition [T] we have 

Jen - e r < \ M (ki + A: 2 )||e f2 || 2 . 

As the desired angular velocity is bounded from the assump- 
tion, there exists a constant B > satisfying 

||(2J-tr[J]/)i? T w d || < || (2J-tr[ J] T)\\\\u d \\ < B. 

< ki + k 2 , we have 

Ml 2 , 



From ( 22 1 and using the fact that 1 1 e 

Jen ■ e r < A M (fci + ^2 ) 1 1 1 1 2 + (B + fea)||en||||e r | 



From these, an upper bound of V can be written as 

V < -z T M 3 z, 
where the matrix A/3 G M 2x2 is given by 



M, = 



c 

c(B+k n ) 
2 



2 



kn - c(h + k 2 )(l + X M ) 
If the constant c is chosen such that 

4k n 



c < mm 



V 



2X m hi 



A M (/i 2 + h 3 ) ' 4fc(l + A M ) + (B + k n ) 2 



(25) 
(26) 

}■ 

(27) 



where k = ki + fe 2 , then the matrices Mi,M 3 are positive 
definite, which shows that the desired equilibrium is asymp- 
totically stable, and e r , en — > as t — > 00. 

However, the fact that e r — > does not necessarily imply 
that R — > R d as t — > 00, since e r = also at three 
undesired equilibria. Therefore, we cannot achieve global 
asymptotic stability for the given control system. Instead, 
to claim almost global asymptotic stability, we show that the 
undesired equilibria are unstable as follows. At the undesired 
equilibrium given by R — exp(nf dl )R d and en = 0, the 
value of the Lyapunov function becomes V = 2fc 2 . Define 

1 



(2fc 2 - *) - ce r ■ en- 
Then, W = at the undesired equilibrium. We have 



W = 2k 2 -V = --en-Jen 



A 



W > -^|M| 2 + (2k 2 - #) - c||e r ||||e n ||. 

Due to the continuity of we can choose R that is arbitrary 
close to exp(Trf dl )R d such that (2fc 2 — \&) > 0. Therefore, 



if 1 1 en 1 1 is sufficiently small, we obtain W > at those 
points. In other words, at any arbitrarily small neighborhood 
of the undesired equilibrium, there exists a domain in which 
W > 0, and we have W = —V > from (25 I. According to 
Theorem 4.3 at [14], the undesired equilibrium is unstable. 
The instability of the other two equilibrium configurations 
can be shown by the similar way. This shows (iii). 

The region of attraction to the desired equilibrium ex- 
cludes the stable manifolds to the undesired equilibria. But 
the dimension of the union of the stable manifolds to the 
unstable equilibria is less than the tangent bundle of SO (3). 
Therefore, the measure of the stable manifolds to the unstable 
equilibrium is zero. Then, the desired equilibrium is referred 
to as almost globally asymptotically stable. 

Next, we show exponential stability. Define U — ■ 
Jen + ^. From (22i and the property (i) of Proposition [T] 
we have IA = — A;jj||eo|| 2 , which implies that U(t) is non- 



increasing. For the initial conditions satisfying ( |20| and (21 
we have U(Q) < ip. Therefore, we obtain 

y(R(t)) < U(t) < U(0) < tp < 2 min{fc 2 , fci}. (28) 



(29) 



Thus, the upper bound of ( p~8] > is satisfied. This yields 

V < z T M 2 z, 



where the matrix c is given by 



M 2 



2hi hj 
hsihi—i/j) 

c\ M 



c\ M 
Am 



(30) 



The condition on c given by (27 1 also guarantees that 
M 2 is positive definite. Therefore, from (23 1, (25 1, and 



291, the desired equilibrium is exponentially stable. The 



initial attitudes R(0) satisfying (20i almost cover SO (3) 
as ki — > k 2 , excluding only three attitudes of undesired 
equilibria, and the initial angular velocities O(0) satisfying 
(21 1 cover K 3 as ki,k 2 — > oo. In short, the set of initial 
conditions (i?(0), f2(0)) that guarantee exponential stability 
almost cover SO (3) x R 3 as k\ ~ > oo and k 2 — > k\. 
Therefore, the desired equilibrium is almost semi-globally 
exponentially stable. This shows (ii). ■ 

Compared with other attitude control systems achieving 
almost global asymptotic stability for attitude stabilization of 
time-invariant systems on SO(3), such as [5], this proposition 
guarantees stronger almost semi-global exponential stability 
for attitude tracking of time-varying systems. Unlike attitude 
control systems based on quaternions, such as [2], the 
proposed control system is directly developed on SO (3). 
Therefore, it completely avoids unwinding behaviors of 
quaternion based attitude control systems [3]. 

The fact that the region of attraction does not cover the 
entire configuration manifold globally is not a major issue in 
practice, as the probability that a given initial condition ex- 
actly lies in the stable manifolds to the unstable equilibria is 
zero, provided that the initial condition is randomly chosen. 
But, the existence of such stable manifolds may have strong 
effects on the dynamics of the controlled system [15]. In 
particular, the proportional terms of the control input, namely 
e ri , e r2 approach zero as the attitude becomes closer to one 



of the three undesired equilibria, thereby causing a slow 
convergence rate for large attitude errors. In the following 
subsection, discontinuities are introduced in the control input 
to improve convergence rates, in addition to obtaining global 
exponential stability. 

B. Hybrid Control for Global Attitude Tracking 

Recently, hybrid control systems for global attitude sta- 
bilization are developed in terms of quaternions [6], and 
rotation matrices on SO (3) [7]. The key idea is switching 
between different form of configuration error functions, 
referred to as synergistic potential functions, such that the 
attitude is expelled from the vicinity of undesired equilibria. 
The switching logic is defined with a hysteresis model to 
improve robustness with respect to measurement noises. 
This paper follows the same framework, but a new form 
of synergistic configuration error functions is provided to 
simply controller structures and controller design procedure. 
The given control system also provides stronger global 
exponential stability that is uniformly applied to time-varying 
systems for tracking problems. 

For control analysis, we introduce a mathematical formu- 
lation of hybrid systems [16]. Let Ai be the set of discrete 
modes, and let Q be the domain of continuous states. Given 
a state (m, £) g Ai x Q, a hybrid system is defined by 



i+=S(m,0, (m.Oe©, 



(31) 
(32) 



where the flow map T : Ai x Q — >• TQ describes the 
evolution of the continuous state £; the flow set C C Ai x R™ 
defines where the continuous state evolves; the jump map 
Q : Ai Ai governs the discrete dynamics; the jump set 
T) c Ai x Q defines where discrete jumps are permitted. This 
represents a class of hybrid systems, where the continuous 
state does not change over jumps. 

For the presented hybrid attitude control system, there are 
a nominal mode and two expelling modes. The control input 



at the nominal mode is equal to (19 1 which is constructed 
by the following configuration error functions given at (13) : 



V Nl (Ebi) = l-Rb 1 - r dl , 
$ N2 (Rb 2 ) = 1-Rb 2 - r d2 , 



(33) 
(34) 



where the subscripts N are used to explicitly denote that 
the configuration error functions are for the nominal mode, 
i.e., ^tv; — ^i- When the attitude becomes closer to the 
critical points of the nominal configuration error functions, 
they are switched to the following expelling configuration 
error functions: 

* fix (Rh) =a + j3Rb x ■ (r dl xr d2 ), (35) 
* fi2 (i?6 2 ) = a + f3Rb 2 ■ {r dl xr d2 ), (36) 

for constant a, ft satisfying 1 < a < 2 and \/3\ < a — 1. 

For example, if the attitude becomes close to the critical 
point of the first nominal error function ^>n 1 where Rbi — 
—r dl , the expelling configuration error is engaged such 
that Rbi is steered toward a direction normal to — r dl , 



namely — y^j x r d 2 ), to rotate the rigid body away from 
the undesired critical point. Similarly, the second expelling 
configuration error function "J e 2 is engaged near the critical 
points of the second nominal configuration error function 
^n 2 - As a result, there are three discrete modes, namely 
M = {I, II, III}, and the configuration error function for 
each mode is given by 



Proposition 3: Consider a hybrid control system defined 



* I (R) = k 1 * Nl (Rb 1 ) 



k 2 ^ N2 {Rb 2 ), (37) 
k 2 ^ E2 (Rb 2 ), (38) 
k 2 ^ N2 {Rb 2 ). (39) 



In short, the nominal control input is constructed from the 
nominal error function j. If the attitude is in the vicinity 
of the undesired critical points of or *&n 2 , the control 
input is switched into the mode III or II, respectively. 

The switching logic is formally specified as follows. 
Define a variable p representing the minimum configuration 
error for the given attitude: 



p(R) = mmW m (R)}. 



(40) 



The discrete mode is switched to avoid the undesired crit- 
ical points of the nominal configuration error functions 
VP jVi ,^n 2 - Observing that the values of , ^ n 2 are maxi- 
mized at the undesired critical points, the jump map is chosen 
such that the discrete mode is switched to the new mode 
where the configuration error is minimum: 

Q{R) = argmin{* m (i?)} = {m e M : * m - p}. (41) 

mEM 

It is possible to switch whenever a new discrete mode with 
a smaller value of configuration error function is available, 
or equivalently, when G(q) ^ q or $ m — p > 0. But, 
the resulting controlled system may yield chattering due to 
measurement noises. Instead, a hysteresis gap 5 is introduced 
for robustness, and a switching occurs if the difference 
between the current configuration error and the minimum 
value is greater than the hysteresis gap. More explicitly, the 
jump set and the flow set are given by 

V = {(R,n,m):V m -p>6}, (42) 
C = {{R,n,m):^ m -p<S}, (43) 



for a positive constant 5 that is specified later at (48 1. 

The control input at each mode is constructed from the 
corresponding configuration error function by following the 
same procedure described in the previous section: 

u = -e H - k n e n + (R T u Jd ) A JR T uj d + JR T uj d . (44) 

where the hybrid configuration error vectors are defined as 

e H = k\e Hl + k 2 e H2 , (45) 
\e ri = R T r dl xbi if m = /, 77, 

I -PR 1 (r dl xr d2 ) xb x if m = III, 



en 2 



R T r d2 x 6 2 



if m = /, III, 



-f3R T (r dl xr d2 ) xb 2 if m = II. 



(47) 



by (37i-(47i. For given constants k\,k 2 ,a.,$ satisfying 
ki, k 2 > 0, ki ^ k 2 , 1 < a < 2 and < a — 1, choose 
the hysteresis gap 6 such that 



< 5 < minj/c!, k 2 } min{2 — a, a 



1}. (48) 



Then, the desired equilibrium (R d ,uj d ) is globally exponen- 
tially stable. 

Proof: The set of values for (ri,r 2 ) — (Rbi,Rb 2 ) 
at the critical points of each configuration error func- 
tion is given by Tli = {(r 1 ,r 2 )\(±r dl ,±r d2 )}, TZ n = 
{(n,r 2 ) | {±r dl ,±r dl x r d2 )}, K IH = {(n.,r 2 ) | (±r dl x 
r d2 ,±r d2 )}. Therefore, there are twelve critical points in 
total, including the desired equilibrium (r dl ,r d , ), and eleven 
undesired critical points. 

We first show that the undesired critical points cannot 
become an equilibrium of the controlled system as they 
belong to the jump set T>. At the first undesired critical 
point of ^>], namely (ri,r 2 ) — (r dl , — r d2 ), the values of 
the configuration error functions are given by 

f/ = 2fc 2 , *// = afc 2 , ^iu = aki +2k 2 . 

which gives p = min m 'I'm = ak 2 as a < 2. This yields 
*i>i — p = (2 — a)k 2 > S from the definition of S given 
at ( |48] >. Therefore, the first critical point corresponding to 
(ri,r 2 ) = (r dl , —r d2 ) lies in the jump set T>. Similarly, for 
the first critical point of ^n, namely (ri,r 2 ) = (r dl ,ri d x 
r d . 2 ), we have \& // = (a + f3)k 2 and p = k 2 to obtain 
^11 — p = (a + (3 — l)k 2 > 5, which shows that the critical 
point lie in the jump set. This can be repeated for all other 
remaining 9 undesired critical points to show that all of the 
undesired critical points of the configuration error functions 
belong to the jump set. Thus, the only equilibrium is the 
desired equilibrium. 

The remaining part of the proof is similar to the proof of 
Proposition|2] For the nominal mode m = I, all of properties 
at Proposition [T] are automatically satisfied as the definitions 
of the configuration error function and error vectors are 
identical. Furthermore, since the flow set C is compact, and 
p^ip is continuous in C (as e r ^ in C), there exists a 
maximum value, namely 7 > such that 

*<7lk|| 2 , (49) 

for any R, R d in the flow set C. We can show the same 
properties for ^jj and 



Define a Lyapunov function on M. x (SO (3) 



as 



m + ceo • e H . 



This is positive definite about the desired equilibrium at 
m = I. According to the above properties and the proof 
of Proposition [2] V m is positive definite and decrescent with 
respect to quadratic functions of e# and e^, and V m is less 
than a negative quadratic function of of ch and eji in the flow 
set C. Therefore, the error variables en and en exponentially 
decrease in the flow set C. 



Note that the desired angular velocity uj d , therefore en 
does not change over any jump, since d j(rd 1 x r^) = 

x (fdi x rd 2 )- Therefore, V m strictly decreases overjumps 
in the jump set T>, if the constant c that is independent of 
control inputs, is sufficiently small. It follows that the desired 
equilibrium is globally exponentially stable. ■ 

The unique feature of the proposition is that it provides a 
stronger global exponential stability for a tracking problem 
on SO(3), compared with the existing results in [7] yielding 
global asymptotic stability. Another interesting feature is 
that the construction of the expelling configuration error 
functions are simpler. In [7], an expelling configuration 
error function is constructed by angular wrapping, where 
the nominal configuration error function is composed with 
a diffeomorphism that represents stretched rotations. The 
resulting control system design involves nontrivial deriva- 
tives and it is relatively difficult to compute the required 
hysteresis gap 5, that is required to implement the given 
hybrid controller. 

In this paper, the construction of expelling configuration 
error function at ( |35| l, p6"| ) is intuitive and straightforward 
as they are based on the comparison between the desired 
directions and the actual directions. It is not required that the 
critical points of x &e 1 , 1 &e 2 include the desired equilibrium. 
The proposed simpler form of the expelling configuration er- 
ror functions yields the explicit expression for the hysteresis 



gap as given at (48 1. For example, at (48 1, the upper bound 
of 5 is maximized along the line of 2a — \f3\ — 3 = to 
yield 8 = 2 — a. If a = 1.6, then we can simply choose 
[3 = 0.2 to obtain 5 = 0.4. In short, the presented control 
system provide a stronger global exponential stability, with 
simpler controller design procedure. 

IV. Robust Global Attitude Tracking 

In this section, we consider a case where there exists 
unknown, but fixed disturbance A. Both of smooth and 
hybrid attitude control systems are constructed. 

A. Robust Almost Global Attitude Tracking 

It is well known that steady state errors due to fixed 
disturbances can be attenuated by an integral term of the 
error. In this paper, we consider the following integral term, 



e/(i) 



ce r (r) + en(r) dr, 



(50) 



for a positive constant c satisfying (27 1, or equivalently, it 
satisfies ej = ce r + en with ej (0) = 0. The smooth attitude 
control system developed at Section |III-A| can be extended 
with the integral term for robustness as follows. 

Proposition 4: Consider the dynamic system dTJ, ([2]) 
on SO(3). A desired trajectory is given by (12i. For 
ki,k 2 ,ki, fen > with ki ^ k 2 a control input is chosen as 

u = ~e r - k n en - fc/e/ + (R T uj d ) A JR T uj d + JR T Co d . 

(51) 



(i) There are four equilibrium configurations for (R,u>), 
given by the property (i) of Proposition [2] 

(ii) The desired equilibrium (Rd,Ud) is almost globally 
asymptotically stable, and locally exponentially stable 
with respect to e r , enf^The integral term ej is globally 
uniformly bounded. 

(iii) The three undesired equilibria are unstable. 

Proof: Here, the expression for Jen at ( 22 1 is aug- 
mented with the disturbance A and the integral term as 



Je n = {Jen + (2J - tr[J] I)R 7 w d } A e n 

- kie ri - k 2 e r2 - k n en - fc/e/ + A. 



(52) 



Equilibria of the controlled system corresponds to the con- 



figurations where e r — 0, en — 0, and e/ = 
proof of Proposition [2] this shows (i). 
Define a Lyapunov function: 



V' = 
From ([18 

z T Miz -+ 



1 



-e n ■ Jen + * + cJen 



kj_ 
2 1 



, it is bounded by 

fez A 

T l|e/ -fc7 



II 2 < V < z T M 2 z- 



e/ 
2 1 



From the 



5' 



e/ 



en 



(53) 

and the matrices Mi , M 2 £ 



where z = [\\t 

E 2x2 are given by <[24j and <[30}, The upper-bound of V is 



only satisfied when "J < ijj < 2 min{fci, k 2 } from ( 18 1. 

From ( |52| , the time-derivative of the Lyapunov function 
is given by 



V' = -k 



n||en|| 2 + c(Jen + kjei — A) • e r + cJen ■ e r 



Substituting (52 1, the effects of the integral term ej and the 



disturbance A are completely eliminated at V", and an upper 
bound of V' can be obtained exactly as ( 25 1, 



V' < -z 1 M 3 z, 



(54) 



where the matrix M 3 £ M. is given by (26 1. For the given 
constant c satisfying ( 27 1, all of matrices Mi , M 2 , M3 are 
positive definite. This implies that the desired equilibrium 
is stable in the sense of Lyapunov, and e r , en — > as 
t — > 00. It also shows that V', and therefore e/ is globally 
uniformly bounded. Therefore, the desired equilibrium is 
asymptotically stable with respect to e r ,en [17, Chapter 
4]. The instability of the undesired equilibria can be shown 
by following the same approach given at the proof of 
Proposition [2] These show almost global asymptotic stability 
with respect to e r and en- 

For exponential stability, the upper bound of ( |5"3"j ) should 
be satisfied, or $ < ^ < 2min{fc 1 ,fc 2 }- Unlike the proof 
of Proposition [2] we do not have a sufficient condition on 
the initial conditions to satisfy < ip < 2min{fci,fc2}. 
Therefore, we can only guarantee local exponential stability 
with respect to e r and en- ■ 

Nonlinear PID-like controllers have been developed for 
attitude stabilization in terms of modified Rodriguez param- 
eters [9] and quaternions [11], and for attitude tracking in 



Then, the controlled system satisfies the following properties: 



'See [17, Chapter 4] for the formal definition of partial stability. 



terms of Euler-angles [10]. The proposed control system 
is developed on SO(3), therefore it avoids singularities of 
Euler-angles and Rodriguez parameters, as well as unwinding 
of quaternions. It also provides almost global asymptotic sta- 
bility for attitude tracking problems with fixed uncertainties. 
The proposed integral term is unique in the sense that 



the angular velocity error term is also integrated at (50i. As 
the time-derivative of the error vector, namely e r is linear 
with respect to the angular velocity error en, this has the 
effects of increasing the proportional term of the control 
input. Effectively, the proportional gain of the control input 
is given by ki,h2 multiplied by 1 + ki, and the integral 
gain of the control input is given by ckj. The constant c 
essentially determines the ratio of the integral gain to the 
proportional gain. In most of nonlinear PID-like controllers 
for mechanical systems, the integral gain is limited by 



proportional gains for stability, as reflected by ( 27 1 



One of the desirable properties of the proposed control 
input with an integral term is that the resulting time- 
derivative of the Lyapunov function is exactly same as the 
attitude tracking system given in the previous section without 
disturbances. Therefore, the guaranteed performance of the 
controlled system, such as convergence rates, is not affected 
by fixed disturbances, and stability proof becomes simpler. 
The proposed form of the integral term may be used for other 
second-order mechanical systems. 

B. Robust Global Attitude Tracking 

The proposed attitude control system with an integral term 
can be further developed into a hybrid control system to 
achieve robust global exponential stability. The integral term 



is redefined in terms of the hybrid error vector ( 45 1 as 



ce ff (r) + en{r)dT, 



(55) 



for a constant satisfying ( 27 1, and the jump set and the flow 
set are revised as 

S 



V = {(i?,n,m) 
C = {(R,n,m) 
where k = k\ + k<2. 
u = -e H - fcnen - 



en 



— p > S and 

- p < 5 or ||e n 
The control input is chosen as 



i 1 



1 - 4cF' 
> —\ 



(56) 
(57) 



kie lH + (R T uj d ) A JR T uj d 



JR 1 dj d . 
(58) 

The other parts of the hybrid control system, such as the 
configuration error functions and the jump map are identical 
to Section UlTBl 

Proposition 5: Consider a hybrid control system defined 
by (|g7)-(PI), <|4"5)-<|47]), and Q-((57]l. For given constants 
ki,k2,a,/3 satisfying fci,&2 > 0, k\ ^ fea, 1 < ot < 2 
and |/3 1 < a — 1, choose the hysteresis gap 6 such that 



(48 i is satisfied. Then, the desired equilibrium (R dl uj d ) is 
globally exponentially stable with respect to en and en, and 
the integral term ej H is globally uniformly bounded. 

Proof: As shown at the proof of Proposition^ all of the 
undesired critical points of the configuration error functions 



V 



lie in the jump set V, and Proposition [T] with (49 1 is satisfied 
in the flow set C. Define a Lyapunov function as 

1 k Iu A l|9 

-e n • Je + W m + ce n ■ e H + — ej - — . 

2 2 ki 

From the proof of Proposition [4J V' m is negative definite with 
respect to a negative quadratic function of e# and en in the 
flow set C 

Since en is not changed over any jump, the change of the 
Lyapunov function over the jump from a mode m € M. is 

V' G - V m = p - * m + cen • e H f m <S + 2ck\\e n \\, 
where we use the fact that (leg- II <= k. From the definition 



of the jump set, given at (56 1, we have VA — V' m < — | < 0, 



which implies that the Lyapunov function strictly decreases 
in the jump set V. Therefore, the desired equilibrium is 
global exponentially stable with respect to en and en, and 
the integral term is globally uniformly bounded. ■ 
Global asymptotic stability is achieved for an attitude 
control system with an integral term in terms of quaternions, 
based on LaSalle's principle [12]. To the best knowledge 
of the author, the given robust global exponential stability 
for attitude tracking, developed in terms of global attitude 
representation without need for addressing unwinding, has 
been unprecedented. 

V. Numerical Examples 

Consider a rigid body whose inertia matrix is given by 
,/ = diag[3, 2, 1] kgm 2 . The desired attitude command is 
specified as R d (t) = exp(^(t)e3) exp(0(t)e2) exp(</>(i)ei) 
in terms of 3-2-1 Euler-angles, where (f>(t) = sin0.5i, 6(t) — 
0.1( — 1 + <), ip(t) = 1 — cost. The controller parameters are 



[0,1,0] 



1.9, $ = 0.8, 



chosen as b\ = [1,0,0] , 62 
5 = 1, ki = 10, k 2 = 11, k n = 4.42, fc/ = 0.5. 

The following three cases are considered. 

Case (I): It is assumed that there is no disturbance, i.e., 
A = 0, and the initial conditions are chosen as R(Q) = I 
and £1(0) = 0. This corresponds to a small initial attitude 
error, where ^(0) = 0.05. The simulation results for the 
smooth control system and the hybrid control system without 
an integral term, developed at Propositions [2] and [3] respec- 
tively, are illustrated at Figure [T] They exhibit good tracking 
performances. As the initial attitude error is small, no jump 
occurs at the hybrid control system, and the corresponding 
responses of the hybrid control system are identical to the 
smooth control system. 

Case (II): The second case is same as Case (I), except 
the initial condition chosen as R(0) = exp(0.99997r(r ( i 1 x 
rd 2 ) A )Rd(0), ^(O) = R(0) T uj d (0), which is close to one 
of the undesired equilibrium. In this case, there is noticeable 
difference between the smooth controller and the hybrid con- 
troller, as illustrated at Figure [2] For the smooth controller, 
the attitude tracking error does not change until after t = 12 
seconds. The convergence rate of the hybrid control system 
is significantly faster. 

Case (III): The initial condition is identical to Case 
(II), representing a large initial attitude error. In this case, 



a fixed disturbance of A = [— 1,2,1] T is included. Figure 
[3] shows numerical results for the hybrid control system 
presented at Proposition [3] and the hybrid control system 
with an integral term presented at Proposition [5] The given 
fixed disturbance causes steady-state tracking errors for the 
hybrid control system developed at Proposition [3] but those 
errors are completely eliminated by the integral term of the 
hybrid control system developed at Proposition [5] It also 
exhibits good convergence properties for the given large 
initial attitude error, which are comparable to the hybrid 
control system without disturbances illustrated at Figure [2] 

Appendix 
A. Proof of Proposition [7] 

From Q and ( 12 1, and using ^ and |7b, 

*j = -Rflbi ■ r di - Rbi ■ (uj d x r di ) 

= ^ ■ (R T r dt x bi) - h ■ {R T Lo d x R T r di ). 

Substituting = + R T uj d into this, we obtain (i). 
Using Q and (111, e r . can be written as 



e ri = hr^R- R T r di bf = b^R^R - R T R d b t bJ . 
Using (|7j, the time-derivative of R d R is given by 

d 



dt 



— —R^ujciR + R^Rfl — R^R&fi. 



(59) 



(60) 



Therefore, we have 

e r . = bibfR d Ren + e.Q,R T R d hbJ , 

= (Mni? T i?A) A , 

where we used Q. This shows (ii). 




(a) Attitude tracking error \\R — -Rdi I 0>) Attitude error vector eu 



n.()5 r 




(c) Angular velocity error en 



(d) Control input u 



Fig. 1. Case 1: small initial attitude error without disturbances 
(blue,solid:smooth controller, red,dashed:hybrid controller) 



(a) Attitude tracking error \\R — R^W (b) Attitude error vector ejj 



(c) Angular velocity error eo 



(d) Control input u 



Fig. 2. Case 2: large initial attitude error without disturbances 
(blue,solid:smooth controller, red,dashed:hybrid controller) 



Since x T y = tr[xy T ] for any x, y € M 3 , we have 

* = jfei + k 2 - tr[i?(/ci6 1 rj i + k 2 b 2 rjj] 
= fei + k 2 - tr[iJ(jfei6i6?' + fc 2 & 2 &2 )Rd] 
= k 1 +k 2 - tr[R(UGU T )Rj] 
= tv[G(I - U T R%RU)] , (61) 

where G = diag[fci, k 2) 0] € R 3x3 , and U = [b 1 ,b 2 ,b 1 x 
b 2 ] G SO(3). From (59 1, the error vector e r can be rewritten 
as 



UGU T RjR - R r R d UGU J 



(62) 



Next, we use the following properties given in [18]. For 
non-negative constants fi,f 2 ,h, let F = diag[/i, f 2 , f 3 ] £ 
]R 3x3 , and let P £ SO(3). Define 



*=\tr[F(I-P)], 



e P 



-(FP- P T F) X 



(63) 
(64) 



Then, $ is bounded by the square of the norm of ep as 

T-jr- e P 2 <<E< , * ,J M 2 , (65) 
h 2 + h 3 h 5 (h 1 - <p) 

if $ < <j) < hi for a constant 0, where are given by 

hi = min{/i + / 2 , f 2 + / 3 , / 3 + /1}, 
^ 2 =max{(/ 1 -/ 2 ) 2 , (/ 2 -/ 3 ) 2 , (/3-/1) 2 }, 
/i 3 =max{(A + / 2 ) 2 , (/ 2 + / 3 ) 2 , (/ 3 + A) 2 }, 
h 4 = max{/i + / 2 , / 2 + / 3 , / 3 + /1}, 
/ l5 =min{(/ 1 + / 2 ) 2 , (/ 2 + / 3 ) 2 , (/ 3 + /i) 2 }. 



A A--. 













(a) Attitude tracking error \\R— Rd\\ (b) Attitude error vector ejj 
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(c) Angular velocity error en 



(d) Control input u 



Fig. 3. Case 3: large initial attitude error with disturbances 
(red,dashed:hybrid controller, black,solid:hybrid controller with an integral 
term) 



Note that if we choose F = 2G and P = U T RjRU, then 
we have ^> = <3>. Substituting these into ( |64) , 

e P = (GU T R%RU - U T R T R d UG) 

= U T {UGU T R T d R - R T R d UGU T )U = U T e r U 



from (62 1. Therefore, ||ep|| = ||E/e r || = ||e,,||. Substituting 



this into ( |65] >, we obtain ( pT8[ >. 
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